from MiniBotControlLib import MiniBotControlLib


#
#        API:int SetPositionSync(unsigned char* id, double* angle, int count)
#  Description:用户可通过调用此API同时进行多个关节模块运动角度的控制
#	Arguments:id unsigned char类型指针，用户可先建立一个存放多个关节模块id的数组，并把该数组名传入函数中;
#			  angel double类型指针，用户可先建立一个存放多个关节模块各自运动角度的数组，并将该数组名传入函数中;
#			  count int类型指针，即为数组的长度，或用户希望控制的id值的个数。
#	   return:res int类型，大于0即表示设置成功，等于0表示设置失败。
#

#id = c_ubyte*2
#idarry = id(25,39)
#position = c_double*2
#positionarry = position(150,60)
#count = c_int(2)
#res1 = BW.SetPositionSync(idarry,positionarry,count)
#if res1:
#    print("设置成功")
#else:
#    print("设置失败")

mlib = MiniBotControlLib()
r = mlib.Connect("192.168.1.129",8899)
if(r > 0):
 print("连接成功")
else:
 print("连接失败")

res =mlib.SetPositionSync([25,37],[23.9,90])  
if res:
    print("设置成功")
else:
    print("设置失败")
